#ifndef __SENSORS_PRINT_H__
#define __SENSORS_PRINT_H__

#include <xqueue.h>
#include <xtask.h>
#include <rrcon.h>

#include "sensors_read.h"
#include "sensors_print.h"
#include "gyro_manager.h"

namespace sensors_test {
    using namespace kthrobot;

    class SensorsPrinter : public XTask {
    public:
        SensorsPrinter(SensorsDataQueue *data_queue, AnglesQueue *angles_queue);
        virtual ~SensorsPrinter();
        void TaskCode();

    private:
        SensorsDataQueue *data_queue_;
        GyroManager gyro_manager_;
    };
};

#endif // __SENSORS_PRINT_H__
